geometry_msgs/Point position
hexapod_msgs/RPY orientation
